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Abstract 

This paper studies decentralized formation control of multiple vehicles when each vehicle can only 
measure the local bearings of their neighbors by using bearing-only sensors. Since the inter- vehicle 
distance cannot be measured, the target formation involves no distance constraints. More specifically, the 
target formation considered in this paper is an angle-constrained circular formation, where each vehicle 
has exactly two neighbors and the angle at each vehicle subtended by its two neighbors is pre-specified. 
To stabilize the target formation, we propose a discontinuous control law that only requires the sign 
information of the angle errors. Due to the discontinuity of the proposed control law, the stability of 
the closed-loop system is analyzed by employing a locally Lipschitz Lyapunov function and nonsmooth 
analysis tools. We prove that the target formation is locally finite-time stable with collision avoidance 
guaranteed. The evolution of the vehicle positions in the plane is also characterized. 



Index Terms 

Bearing-only measurement; discontinuous dynamic system; finite-time stability; formation stabiliza- 
tion; Lyapunov function 



I. Introduction 

Formation control of multiple vehicles has been studied extensively in the last decade. Inter-vehicle 
information exchange is a necessary condition for distributed formation control. It is commonly assumed 
that each vehicle can obtain the relative position information of their neighbor vehicles via, for example, 
wireless communication. It is notable that position information essentially consists of two kinds of partial 
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information: range and bearing. In recent years, formation control using range-only JTJ, (2j or bearing- 
only (3J-JHJ measurements has become an active research area. Up to now, many problems are still 
unsolved in this area. In this paper, we will particularly study formation control using bearing-only 
measurements. We assume that each vehicle is only able to measure the bearings of their neighbors by 
using, for example, monocular or omnidirectional cameras, which are inherently bearing-only sensors 
and have been applied in many control-related tasks. Vision-based formation control (7J-|[9j could be a 
potential application of our work. 

A number of interesting problems arise when only bearing measurements are available for formation 
control. One important problem is how to utilize these bearing-only measurements. There are generally 
two possible schemes. In the first scheme, each vehicle can track their neighbors using the bearing-only 
measurements such that the positions of their neighbors can be estimated and then used for formation 



control. There exist various bearing-only target tracking algorithms (see, for example, [ 10 1). But it should 
be noted that bearing-only target tracking requires certain observability conditions (TT1. As a trivial 
example, suppose two vehicles can measure the bearings of each other but have no relative motion. Then 
it would be impossible for them to estimate their inter-vehicle distance using bearing-only tracking. As 
a result, if the relative positions of the vehicles are supposed to be fixed in the target formation, the 
observability problem would become severe and then the first scheme is inapplicable. In order to apply 
the first scheme anyway, one may adopt a stop-and-go strategy like the one proposed in JTJ. 

In this work we will focus on the second scheme, in which the formation control law is directly 
implemented based on the bearing-only measurements. No vehicle position estimation is involved. If 
merely bearing measurements are used for feedback control, the inter-vehicle distance in the formation 
would be uncontrollable. As a result, any constraints involving inter-vehicle distance cannot be specified 
in the target formation. It is only possible to specify the bearings of the edges that connect vehicles 
j6j, 1 12 1 or the angles at each vehicle subtended by their neighbors J3J-J5J. If the target formation 
is constrained by edge bearings, global bearing measurements are required. That means the bearing 
measurements of different vehicles should be taken in one global coordinate frame. As a comparison, if 
the target formation is constrained by angles, each vehicle may measure the bearings of their neighbors 
in their local coordinate frames. In this paper, we will particularly study the angle-constrained case. It 
should be noted that the realization of an angle-constrained target formation would not be unique. More 
specifically, the orientation or translation of the formation in the plane, or the scale of the formation is 
not unique. In our work, we make no parallel rigid assumptions jSJ, fT2} , |13|. Hence the shape of the 
target formation might not be unique either. 
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Collision avoidance is an important issue in formation control problems. This issue is especially 
important and also challenging to analyze in formation control using bearing-only measurements because 
the inter-vehicle distance cannot be measured. In J3j, a bearing-only control law is proposed to globally 
stabilize a triangle formation of three vehicles. It is proved that collision can be avoided naturally by the 
proposed control law. In our previous work [ 14 1, we extended the work in (3j and proposed a bearing-only 



control law to stabilize circular formations of an arbitrary number of vehicles. By employing Lyapunov 
approaches, we proved that collision avoidance can be ensured if the initial angle errors are sufficiently 
small. A similar idea will be adopted in this paper to tackle the collision avoidance issue. We will prove 
that the formation can be stabilized within finite time before any vehicles could possibly collide. 

In this paper, we study distributed formation stabilization using local bearing-only measurements. The 
target formation considered in this paper is an angle-constrained circular formation, where each vehicle 
has exactly two neighbors. The underlying information flow is described by an undirected circular graph 
with fixed topology. The angle at each vehicle subtended by its two neighbors is constrained in the 
target formation. We propose a distributed discontinuous control law to stabilize the target formation. 
The proposed control law only requires sign information of the angle errors and is able to stabilize the 



target formation in finite time. Finite-time control has attracted much attention in recent years [15|-[21], 



to name a few. Besides fast convergence, finite-time control can also bring benefits such as disturbance 



rejection and robustness against uncertainties [22]. Due to the discontinuity of the proposed control 



law, we employ a locally Lipschitz Lyapunov function and nonsmooth analysis tools [20], [|23|-[|28| to 
prove the finite-time stability of the closed-loop system. It is also proved that collision avoidance can be 
guaranteed if the initial angle errors are sufficiently small. 

The paper is organized as follows. Preliminaries regarding graph theory and nonsmooth analysis are 



introduced in Section [IT] The formation control problem is formulated in Section [TTTJ The formation 
stability and behavior are analyzed in Section [TV| Section [V] presents simulation results. Conclusions are 
drawn in Section [Vl] 

II. Notations and Preliminaries 

A. Notations 

Given a symmetric positive semi-definite matrix A £ M n><n , the eigenvalues of A are denoted as 
< \i(A) < X 2 (A) < ••• < X n (A). Let 1 = [1,...,1] T <E W 1 , and I be the identity matrix with 
appropriate dimensions. Denote | • | as the absolute value of a real number, and || • || as the Euclidean 
norm of a vector. Denote Null(-) as the right null space of a matrix. Let [ • ]y be the entry at the ith row 
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and jth column of a matrix, and [ • ]j be the ith entry of a vector. Given a set S, denote S as its closure. 
For any angle a£l, 

cos a — sin a 



R(a) 



el M (l) 

sm a cos a 

2 



is a rotation matrix satisfying R l (a) = R T (a) = R(—a>). Geometrically, R(a) rotates a vector in 
counterclockwise through an angle a about the origin. 

B. Graph Theory 

A graph Q = (V, £) consists of a vertex set V = {1, ... , n} and an edge set £ C V x V. If (i, j) G £, 
then i and j are called to be adjacent. The set of neighbors of vertex i is denoted as Mi = {j G 
V | € <S}. A graph is undirected if each G £ implies G £, otherwise the graph is 

directed. A path from i to j in a graph is a sequence of distinct nodes starting with i and ending with j 
such that consecutive vertices are adjacent. If there is a path between any two vertices of graph Q, then 
Q is said to be connected. An undirected circular graph is a connected graph where every vertex has 
exactly two neighbors. 

An incidence matrix of a directed graph is a matrix E with rows indexed by edges and columns 
indexed by vertice^] Suppose (j, k) is the ith edge. Then the entry of E in the ith row and kth column 
is 1, the one in the ith row and jth column is —1, and the others in the ith row are zero. By definition, 



we have El = 0. If a graph is connected, the corresponding E has rank re — 1 (see [29 Theorem 8.3.1]). 
Then Null(£) = span{l}. 

C. Nonsmooth Stability Analysis 



Next we introduce some useful concepts and facts regarding discontinuous dynamic systems (20J, 
(23j-(28j. 

1 ) Filippov Differential Inclusion: Consider the dynamic system 

x(t) = f (x(t)) , (2) 

where / : R n — > M. n is a measurable and essentially locally bounded function. The Filippov differential 
inclusion |23| associated with the system Q is 

xeT[f](x), (3) 



'in some literature such as 
edges. 



29 



, the rows of an incidence matrix are indexed by vertices and the columns are indexed by 
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where F[f] : W 1 -> 2 R is defined by 

?[f\(z) = r\ D So{/(S(a:,r)\5)}. (4) 
r>0|t(S)=0 

In Q, co denotes convex closure, B(x,r) denotes the open ball centered at x with radius r > 0, and 
fi(S) = means that the Lebesgue measure of the set S is zero. The set-valued map F[f] associates 
each point x with a set. Note F[f]{x) is multiple valued only if f(x) is discontinuous at x. 

A Filippov solution of (|2]) on [0, t{\ C K is defined as an absolutely continuous function x : [0, t\] — > 
W 1 that satisfies ((3]) for almost all t G [0, ij]. If /(x) is measurable and essentially locally bounded, 
the existence of Filippov solutions can be guaranteed [27, Lemma 2.5] (281 Proposition 3] though the 



uniqueness cannot. The interested reader is referred to [28 p. 52] for the uniqueness conditions of Filippov 
solutions. A solution is called maximal if it cannot be extended forward in time. A set Q, is said to be 
weakly invariant (respectively strongly invariant) for Q, if for each x(0) G f2, SI contains at least one 
maximal solution (respectively all maximal solutions) of ([2]). 

2) Generalized Gradient: Suppose V : W 1 — > E is a locally Lipschitz function. If V(x) is differentiable 
at x, denote VV(x) as the gradient of V(x) with respect to x. Let My be the set where V[x) fails to 



be differentiable. The generalized gradient |24|, [27 1, |28| of V(x) is defined as 



dV{x) = co < lim VV(xi) | i S U My \ , 

where co denotes convex hull and S is an arbitrary set of Lebesgue measure zero. The generalized 
gradient is a set-valued map. If V(x) is continuously differentiable at x, then dV(x) = {W(x)}. 

Given any set S C M n , let Ln : 2 R " — > 2 R " be the set- valued map that associates 5 with the set of least- 
norm elements of S. If S is convex, Ln(5) is singleton. In this paper, we only apply Ln to generalized 
gradients which are always convex. For a locally Lipschitz function V(x), Ln(dV) : M. n — > W 1 is called 
the generalized gradient vector field. The following fact [28, Proposition 8] 



J r [Ln(dV(x))]=dV(x) (5) 

will be very useful in our work. A point x is called a critical point if £ dV(x). For a critical point x, 
it is obvious that Ln(dV(x)) = {0}. 

3) Set-valued Lie Derivative: The evolution of a locally Lipschitz function V{x) along the solutions 



to the differential inclusion x G T[f]{x) can be characterized by the set-valued Lie derivative [26]-[28], 
which is defined by 

C T V{x) = {£ G R | 3£ e T[f]{x), VC G dV{x), £ T ( = £} . 
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With a slight abuse of notation, we also denote CfV(x) = Cj^V{x). The set-valued Lie derivative may 



be empty. When CjV{x) = 0, we take max£j-y(x) = — oo (see |26 -[28 ). 

A function V : W 1 — > R is called regular p8| p. 57] at x if the right directional derivative of V(x) at x 
exists and coincides with the generalized directional derivative of V{x) at x. Note a locally Lipschitz and 
convex function is regular. The following two lemmas are useful for proving the stability of discontinuous 



systems using nonsmooth Lyapunov functions. The next result can be found in (20), |26J , | |27[ , (30). 

Lemma 1: Let V : W 1 — > R be a locally Lipschitz and regular function. Suppose the initial state is 
xq and let Q(xq) be the connected component of {x G W 1 \ V(x) < V(xq)} containing xq. Assume the 
set Sl(xo) is bounded. If maxCfV(x) < or CfV(x) = for all x G Q(xo), then £1(xq) is strongly 
invariant for Q. Let 

z fy = { X g R n I o e (6) 

Then any solution of ([2]) starting from xo converges to the largest weakly invariant set M contained in 
Zfy n fi(xo). Furthermore, if the set M is a finite collection of points, then the limit of all solutions 
starting from xq exists and equals one of them. 
The next result can be found in (20|, (25), (27|. 

Lemma 2: Let V : W 1 — > R be a locally Lipschitz and regular function. Suppose the initial state is xq 
and let S be a compact and strongly invariant set for (|2]). If max CfV{x) < —k < almost everywhere 
on S \ Zfy, then any solution of ((2]) starting at xq G 5 reaches Zjy n S 1 in finite time. The convergence 
time is upper bounded by (V(xq) — mm x& sV(x)) / k. 

III. Problem Statement 

In this section, we first describe the formation control problem that we are going to solve. Then we 
present our proposed control law and derive the closed-loop system dynamics. 



A. Angle-constrained Circular Formation 

Consider n (n > 3) vehicles in the plane. The target formation considered in this paper is an angle- 
constrained circular (or polygon) formation. The underlying information flow among the vehicles is 
described by an undirected circular graph with fixed topology. By indexing the vehicles properly, we can 
have Mi = {i I — 1, i + 1} for i G {1, . . . , n}, which means vehicle i can measure the bearings of vehicles 
i — 1 and % + 1. Note that the indices i — 1 and i + 1 are taken modulo n in this paper. Denote the position 
of vehicle i as Zi G M 2 , and the edge between vehicles i and i + 1 as a = z%+i — Z{. The unit-length 
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Fig. 1: An illustration of circular formations. 



vector gi = ei/\\ei\\ characterizes the relative bearing between vehicles i and i + 1 (see Figure [I]). Hence 
the measurements of vehicle i consist of gi and —g%-\. It should be noted that vehicle i may measure the 
bearings gi and —gi-\ in its local coordinate frame. But in order to analyze the dynamics of the entire 
system, we need to write these bearing measurements in a global coordinate frame. 

The angle subtended by vehicles i—1 and i + 1 at vehicle i is denoted as Bi G [0, 2n). More specifically, 
rotating —g%-\ counterclockwise through an angle Bi about vehicle % yields gi (see Figure [TJ. That can 
be mathematically expressed as 

g i = R(9 i )(-g^ 1 ), (7) 

where R(-) is the rotation matrix in ([T]). By defining Bi in the above way, Bi and Bi + ± are on the same 
side of edge a for alH G {1, . . . , n}. Consequently the quantity Y^i=i @i * s invariant to the positions of 
the vehicles because the sum of the interior angles of a polygon is constant. In the target formation, the 
angle Bi is specified as B* G [0, 2tt). Hence if ^i(O) = EiU d *> then we have E"=l 9 i = Th=i e *- 
The target angles {0*}™ =1 should be feasible such that there exist {zj}f =1 (Zi / Zj for i / j) to realize 
the target formation. Since the target formation is constrained only by angles, its realization would be non- 
unique. Specifically, the orientation, translation and scale of the target formation is non-unique. Moreover, 
since we make no assumptions about parallel rigidity Q, fT2j , fT3|, the shape of the target formation 
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may not be unique either. In fact, the shape of a circular formation cannot be uniquely determined by 
specifying the angles unless n = 3. In order to control the shape of the formation using bearing-only 
measurements, the underlying information flow should be more complicated than a circular graph. For 
example, each vehicles should correspond to more than one angle. We leave formation shape control 
using bearing-only measurements for future work. 

B. Proposed Control Law 

Suppose that no vehicles are collocated in the initial formation, i.e., Z{(0) ^ Zj(0) for all i / j. 
Consider the dynamics of each vehicle as a single integrator: z% = Our task is to design m to steer 
vehicles from their initial positions to a target formation. The angle error corresponding to vehicle i is 
chosen as 

Si = cos Oi — cos 9* = —gjgi-i — cos 9*. (8) 

The reason why we use a cosine function to define the angle error £j is that cos 9i can be conveniently 
expressed as the inner product of the two bearing measurements g% and —g%-\. The proposed control law 
for vehicle % is 

Zi = sgn(e i )(3 i -gi-i), (9) 

where 

II if £i > 
if Si = • 
-1 if Si < 

For vector arguments, sgn(-) is defined component-wise. 

Remark 1: Compared to the control laws in (3j, |14|, the one (|9]) also steers the vehicles along the 



bisectors of their corresponding angles, respectively. But the control law ([9]) is discontinuous and only 
requires the sign information of the angle errors. Due to the discontinuity, classical Lyapunov approaches 
are inapplicable here. We will prove the stability of the closed-loop system by using a locally Lipschitz 
Lyapunov function and nonsmooth analysis tools. 

From Figure [T] or equation (|7]), it is obvious to see that gi — g^\ = when 9i = tt. Hence the control 
law (|9]) would be ineffective in the case of 9{ = it even though e% is still nonzero. Moreover, when 9i = 0, 
vehicles i — 1 and i + 1 are located on the same side of vehicle i. Since bearing is usually measured by 
optical sensors such as cameras, the bearing of vehicle i — 1 or i + 1 may not measurable by vehicle i 
due to line-of-sight occlusion in the case of 9i = 0. Therefore, we adopt the following assumption. 
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Assumption 1: In the target formation, 9* ^ and 9* 7^ 7r for alii G {1, . . . , n}. 
By Assumption [TJ the target angle f5* is in either (0, 7r) or (ir, 2tt). In other words, no three consecutive 
vehicles in the target formation are collinear. The collinear case is a difficulty in many formation control 
problems (see, for example, Q, 1 3 1 1-|33|). At last, in order to analyze the dynamics of the whole system, 



we need to write the bearings gi for all i 6 {1, . . . , n} in a global coordinate frame. But the control law 
(|9]) can be implemented distributedly even if and — ft-i are measured in the local coordinate frame 
of vehicle i. 

C. Error Dynamics 

Denote e = [e\, e n ] T G R n . Now we derive the dynamics of e. Since g, L = ej/||ej||, the time 
derivative of g^ is 

9i = j^Piei, (10) 

INI 

where P{ = I — g%gl ■ Note Pi is an orthogonal projection matrix satisfying = Pi and Pf = Pi. 
Moreover, Pi is positive semi-definite and Nul^-Pj) = spanj^}. Since = Zj+i — Zi, by the control 
law ([9]), the time derivative of e« is given by 

= Zi+l Zi 

= sgn(e i+1 )(g i+1 - gi) - sgn(ej)(ft - g^i) 

= sgn(e i+ i)g i+ i + sgn(ei)ft_i - [sgn(e m ) + sgn(e;)] ft. (11) 



Substituting (111 into ( 10 1 and using the fact that Pigi = yield 



9i = jr^Pi [sgn(e i+ i)ft + i + sgn(e;)ft_i] . 

INI 

Recall £i = —gjgi-i — cos(6>*) as shown in ([8]) and 9* is constant. Then 

£i = -gjgi-i - al-idi 

idJPi-i [sgn{ei)gi + sgn(£i_i)ft_ 2 ] - 77— u9i-\Pi [sgn(e i+ i)ft + i + sgn(ei)ft_i] 



|| — x I 

-Oj^!) sgn(£i_i) - ausgn(ei) - a i(m) sgn(e m ), 
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where 

1 T 

a i(i-i) — |] u9i Pi-iQi-2, 

W^i— 1 II 

an = |, gfPi-igi + -^—gJ_ 1 P i g i - 1 , 

II ^i— ill ll^ill 
1 T 

a i{i+l) — |] nft-l P%9i+l- 

Hence the dynamics of e can be written as 

i = -Asgn(e), (12) 

where [.AWi-i) = [^4]m = aii and = a^+i) for all i E {l,...,n}; and all the other 

entries of A are zero. By changing the index i of diu+u to i — 1, we can obtain the formula of a(j_i)j. 

It is easy to see that a^.^j = G&i(j_i) for all i and hence A is symmetric. The next lemma shows that A 

is also positive semi-definite. 

Lemma 3: For any x = [x\, . . . , x n ] T G W 1 , 

n 1 

x T Ax = y~] j — 77 (g i+1 x i+1 + gi-iXi) Pi (g i+ ix i+1 + gi-\Xi) > 0. (13) 
i=i 11 411 



As a result, the matrix yl in ( |T2| ) is positive semi-definite. 
Proof: For any vector x = [xi, . . . , x„] T G R n , we have 



T 



Ax=) j ai(i_i)XiXi-i + ajjx 4 2 + a^ i+ i)XiXi + i 

i=l 

= X] I II 1 \\ 9i p i-i9i~2 J a^i-i + ^ ( 1 .. gJPi-igi ) 
i=1 Vll e i-ill / i=1 \ll e »-ill / 

+ (n7n3liPi9i-i) xj + (n7T\9?-i P *9 

- / 1 \ n ( 1 

= XI iTIT 5 ^ 1 ^^- 1 + X! -\TT\9i+i p i9i 

i=i Vl|ei|1 / i=i Vl|ei|1 

+ £ ( JZT\9i-l P i9i-l ) + £ ( JT-n9i-iPi9i+i 

■ i V \ \^i\\ J ■ n V 

1=1 N ' 1=1 N 

n 1 

= ^ Ti il (Si+l^i+l + 9i-lXi) T Pi (gi+lXi+1 + gi-lXi) > 0, 

i=i 11 111 

where the last inequality uses the fact that Pi is positive semi-definite. 



xj 



i+l XiXi+l 



igi+i I xj+i 



XiXi+i 
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IV. Analysis of Formation Stability and Behavior 

The stability of the error dynamics ( fl2] ) is analyzed in this section. By employing a locally Lipschitz 
Lyapunov function and the nonsmooth analysis tools introduced in Section II-C[ we prove that the origin 



e = is locally finite-time stable with collision avoidance guaranteed. In addition to the dynamics of e, 
we also analyze the behaviors of the vehicle positions during formation convergence. 

A. Nonsmooth Lyapunov Function 
Consider the Lyapunov function 

n 

V(e)=J2\£il 

i=i 

which is positive definite with respect to e. Note V(e) is locally Lipschitz and convex. Hence V(e) is 
also regular. By the definition of the generalized gradient, we have 

dV(e) ={ v =[ m ,..., tm] t G R n | Vi = sgn( £j ) if e< ^ and 

rji G [-1, 1] if £i = for i G {1, . . . , n}}. 
Because |r/j| = | sgn(ej)| = 1 if E\ ^ 0, we have the obvious but important fact that 

\r\\ > 1, Vr/ G dV(e), Ve ^ 0. (14) 

In addition, if £{ / 0, Ln({ sgn(ej)}) = {sgn(ej)}; and if £j = 0, Ln([— 1, 1]) = {0} = {sgn(0)}. Thus 
we have the following useful property 

Ln(dV(e)) = {sgn(e)}. (15) 

B. Calculate the Filippov Differential Inclusion 



Consider the error dynamics in (12i. First, the term sgn(e) in (12i is discontinuous in e. Second, it 
is noticed that ||ej|| appears in the denominators of the nonzero entries of A. Hence if [|ej|| can be zero, 
the term A is also discontinuous. Note that ||ej|| being zero simply means that the vehicles i and i + 1 
are colliding with each other. In the initial formation, it is assumed that no vehicles are collocated, i.e., 
Zi(0) / Zj(0) for any i / j. By the control law (|9]) we have ||ij|| < \\gi — gi-\\\ < 2, which means that 
the maximum speed of each vehicle is 2. Thus 

T * = min^j ||z,(0) -Zj(0)\\ 
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is the minimum time when any two vehicles could possibly collide with each other. In other words, 
when t < T*, no vehicles collide with each other, i.e., ||ej(i)|| / 0. In the rest of the paper, we will only 
consider t £ [0, T] with T <T*. We will prove that the system can be stabilized within the finite time 
interval [0,T]. 



Since ||ej(i)|| ^ for all i and all t £ [0,T], the matrix A is continuous. Then by |25 Theorem 1, 



5)], the Filippov differential inclusion associated with the system (12i can be calculated as 



i £ T[-Asgn(e)} = -AF[ sgn(e)]. (17) 



Because {sgn(e)} = Ln(dV(e)) as given in (15i, we have 

JHsgn(e)] = n^(dV(e))] = dV(e), 
where the last equality uses the fact Q. Thus the Filippov differential inclusion in ( [17] ) can be rewritten 



as 



e £ -AdV(e). (18) 



C. Calculate the Set-valued Lie Derivative 



The set- valued Lie derivative of V(e) with respect to (_18i is given by 

£-AdvV(e) = {£ £ R | 3ti G -AdV(e), VC G dV(e), C T ? 



= {£ £ R | 3r/ £ dV(e), VC G dV(e), -( L Ar) = £}. (19) 

When C_ Aav V(e) / 0, for any I £ C_ Adv V(e), there exists rj £ dV such that t = -( T Ar] for all 
C G dV. In particular, by choosing ( = r\ we have 

I = - v T Ari < 0. (20) 

The last inequality is because A is a positive semi-definite matrix as shown in Lemma [3] Now we have 

C_AdvV{z) = or maxC_ Adv V(e) < 0. 



D. Main Convergence Result 

We need to introduce the following results before presenting our main convergence result. 

Given an angle a£R and a vector x £ M 2 , the angle between x and R{a)x is a. Thus for all nonzero 

x £ R 2 , x T R(a)x > when a £ (-vr/2,vr/2) (mod 2vr); x T R{a)x = when a = ±vr/2 (mod 2vr); 
and x T R(a)x < when a £ (tt/2,3tt/2) (mod 2-7r). 
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Lemma 4: Let gf = R{ir/2)gi. It is obvious that = 1 and (g^~) T gi = 0. Furthermore, 

(i) P l= gi{g^. 

(ii) For i / j, {gi) T gj = -(gf) T gi- 

(iii) (g J ± ) T g i _i = sin 0;. Consequently, (g^g^ > if 0* G (0, vr); and (ft- L ) T ft_i < if 0* G (vr, 2vr). 
Proo/- See (14} Lemma 5]. ■ 

Lemma 5: Let G R nx " be a positive semi-definite matrix with \\{B) = and \2(B) > 0. An 
eigenvector associated with the zero eig envalue is 1 = [1, ... , 1] T G M n Let 

W = £ M" ||x|| = 1 and nonzero entries of x are not with the same sign}. 

Then 

. T A 2 ( J B) 
ml x Bx = . 

x&A n 

Proof: See (Wj Lemma 1]. ■ 

Now we are ready to examine the elements in C-AdvV(e) more closely. Note if jO-AdvV{e) = 0* we 

have m&x.£-AdvV( £ ) = — oo. Hence we need only to focus on the case that C-AdvV{ £ ) 7^ 0- Recall 

for any £ G there exists rj G dV such that I = —rj T Arj as shown in pO] ). By ( [T3| ), we can 

further write £ = —rj T Ar] as 

n 1 

^ = - m— ii i.9i+lVi+l + 9i-lVi) T p i (gi+lVi+l + ft-l»7i) 
i=l 

1 " 

- — m Y (fj+i^+i + Qi-im) p i (9i+iVi+i + m-im) 
2-*=i \\ e i\\ i=1 

\ n 2 

= — FIT Yl \ (9i+iVi+l + 9i-iVif 9i (by Lemma [4] (i) ) 
2^=i lie.ll . =1 l 



1 n 

— nr Yl (fi , i L ) T 5i+i^+i + {gl) T gi-im 

l^i=x ||e<|| . =1 l 

- 1 A (21) 
l^i=l \\ e i\\ 
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where 



(gi) T g n 


{gi) T 9 2 










m 





(g^gi 


(giVgs ••• 







m 








(gi) T 9 2 ••• 









(g^fgi 








(Sn) T 5n-l . 




Vn 



with 



E 



1 

1 



-1 



1 



EDr] 

... 
... 
... 

1 



(22) 



(srOV o o 
(gifgi 

(gi) T g 2 



The last equality of (22 1 uses the fact that (g 



gi-i 



o 



{giLi) T gi as shown in Lemma |4| (ii). Note 







(Sn) T Sn-] 



that D is a diagonal matrix and E actually is an incidence matrix of a directed and connected circular 



graph. Substituting ( |22| ) into ( |2lj ) gives 

£ = -r] T Ar] < 



-r] T D T E T EDr]. 



(23) 



We now present the main stability result. 

Theorem 1: Under Assumption [T] if no vehicles are collocated in the initial formation, i.e., Zj(0) / 



Zj(0) for i ^ j and i, j G {1, . . . , n}, the equilibrium e = of system ( 12i is locally finite-time stable. 



Proof: Consider the time interval [0,T] with T <T*. The minimum collision time T* is given in 
( fT6] ). Hence for all f G [0, T], we have ||ej(i)|| 7^ and ||ei(t)|| / +00. We will prove that e can converge 
to zero in the finite time interval [0, T] if e(0) is sufficiently small. 

Let fi(e(0)) = V(e) < V(e(0))}. Since V(e) = £™ =1 M = Hi. the level set ^( e ( )) 

is connected and compact. Because C-AavV(^) = or max£_ J 4gyF(e) < for any e G O(e(0)), we 
know that O(e(0)) is strongly invariant for ( fl2] ) over [0,T] by Lemma [T] 
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Denote 8 i = 9 i - 9* and 6 = [ft, . . . , 5 n ] T G M n . Because Y%=i ^ = ££ =1 0?. we have E?=i = °- 
Thus if 8 0, the nonzero entries of 5 are «of with the same sign. Let 

cos Bi — cos 9* 

Wl= Oi-er ■ 

Then Si = WiS-i and hence 

e = VF<5, 

where = diag{u;i, . . . , w n } G R" xn . Since lim^-^g* tti, = — sinf5*, the equations £j = and 
e = W8 are always valid even when 9{ — 9* = 0. There exists sufficiently small V(s(0)) such that 
9i(0) is sufficiently close to 9* and hence 9 i} 9* G (0,7r) or 6>;,<9* G (vr, 27r) for all e G £](e(0)). Note 
that Wi < if 6>,,#* G (0, 7r), and Wi > if G (vr,27r). Moreover, recall (g l J -) T g i _i > when 

0, G (0,7r), and (g^) T gi-i < when 0j G (vr,27r) as shown in Lemma [4] (iii). Thus we have 

(9i~) T 9i~iWi < 

for all i G {1, . . . , n} and consequently the diagonal entries of DW are with the same sign. Suppose 
e / and hence 5^0. Because the nonzero entries in 5 are not with the same sign, the nonzero entries 
of DW5 and hence De are not with the same sign either. Furthermore, because rn = sgn(ej) if Si 7^ 0, 
the nonzero entry Ej has the same sign with As a result, the nonzero entries of Dr\ are not with the 
same sign either. Thus we have 

with U defined in Lemma [5] In addition, note E is an incidence matrix of a directed and connected 
circular graph. By J29] Theorem 8.3.1], we have rank(S) = n - 1 and Nu\\{E T E) = Null(£0 = {1}. 



Thus inequality p3| ) implies 

1 = 



< 







1 


X 2 (E T E) 


V n lle-l 


n 


1 


X 2 (E T E) 


V iip.i 


n 


1 


\2(E T E) 


V" lle-l 


n 



\\Dr]\\ 2 (by Lemma [5) 



< - „ w r. „" z ^ ^ Axp 2 ), (24) 



where the last inequality uses the fact ||^|| > 1 if e ^ as shown in ( |14j ). 

Now we examine the terms Y^i=i ll e «ll an ^ Ai(-D 2 ) in (24i. First, over the finite time interval [0,T], 



the quantity Ya=i H e *H cann °t g° to infinity because the vehicle speed is finite. Hence there exists a 
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constant 7 > such that Y17=l ll e *H — 7- Second, since D is diagonal, we have Xi(D 2 ) = min^-D]^. 
At the equilibrium point e = (i.e., 9i = 9* for all i), we have [D]a = (g^-) T gi_i / because 9* / 
or 7r as stated in Assumption [T] By continuity, we can still have [D]u / for all e G fJ(e(0)) if e(0) is 
sufficiently small. Because Jl(e(0)) is compact, there exist a lower bound /3 such that Ai(L> 2 ) > /3 for 



all e G $7(e(0)). Then ( [24] ) can be rewritten as 



£ = -Ty T ATy < _ ^ A2 ^ Tg ) = — k < ; Ve G O(s(0)) \ {0}. (25) 
7n 

If e = we have G because of ( fT9] ) and the fact that G dV(0); and if e / we have 

^ £_^4ay^(e) because max£_ J 4ayF(e) < by ( |25] ). Thus by the definition ([6]), we have 

^-^sgn( £ ),y(£) = {0}- (26) 

Based on (25 1, (26) and Lemma |2| any solution of ( fT2| ) starting from e(0) converges to e = in finite- 
time. The convergence time is upper bounded by V(e(0))/ k. If V(e(0)) is sufficiently small, we can 
have 

vmi <T<T , i 

K 

which means that the system can be stabilized within the time interval [0,T]. ■ 



E. Formation Behavior 

Because the target formation is constrained only by angles, the positions of the vehicles or the inter- 
vehicle distance are not specified in the final converged formation. In addition to the dynamics of e, it is 
also important to study the evolution of the vehicle positions z = [zj, . . . , z J] T G M. 2n . Next we identify 
a number of behaviors of the formation controlled by the control law ((9]). 

Firstly, from the control law (|9]), it is trivial to see that z = if e = 0, which means that all vehicles 
will stop moving if all angle errors have converged to zero. 



Secondly, recall the error dynamics is given by e = — Asgn.{e) as shown in ( fT2| ). Similar to the 
derivation of ( [23] ), it can be shown that 

sgn(e) T Asgn(e) > 1 — - sgn(e) T Z? T £ ,T £'Dsgn(e). 

l^i=l \\ e i\\ 



Furthermore, analogous to ( [24] ), we have sgn(e) T ^4sgn(e) = if and only if e = though A is 
merely positive semi-definite. Since ^4sgn(e) = if and only if sgn(e) T ^4sgn(e) = 0, we obtain that 
e = — ^4sgn(e) = if and only if e = 0. As a result, as long as the angle errors are nonzero, the 
angles will keep changing. Hence it is impossible that the formation is moving while all angles are not 
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Time (sec) 

(a) Vehicle trajectory (b) Angle error and Lyapunov function 

Fig. 2: Control results by the proposed control law with n = 3, 9* — 6% = 45 deg and #3 = 90 deg. 



changing. In other words, we can rule out the possibility that only the orientation, translation or scale of 
the formation is changing while the angles are not. 

Thirdly, suppose the target formation is achieved at time tf. The proof of Theorem [T] suggests that 
t f E [0, V(e(0))/«]. Since ||i;|| < ||$ < 2, we have \\zi(t f ) - ^(0)|| < 2V(e(0))/«. Therefore, 

the final converged position z%{tf) is sufficiently close to its initial position Zi(0) if the initial angle error 
s(0) is sufficiently small. In other words, it is impossible that the formation moves through a very long 
distance given very small initial angle errors. 

V. Simulation Results 

In this section, we present simulation results to illustrate our theoretical analysis. Figures [2j [3] [4] 
and [5] respectively show the formation control of three, four, five and eight vehicles. As shown in the 
simulations, the proposed control law can efficiently reduce the angle errors and stabilize the formation 
in finite time. In our stability proof, we assume that the initial angle error e(0) should be sufficiently 
small such that the initial angle 9i and the target angle 9* are in either (0,7r) or (tt, 2tt). However, as 
shown in Figures |3]and[5j even if Oi and 9* may be respectively in the two intervals (0, ir) and (tt, 2ir), 
the formation can still be stabilized. Hence the simulation suggests that the attractive region of the target 
formation by the proposed control law is not necessarily small. 



March 13, 2013 



DRAFT 



18 





Time (sec) 



(a) Vehicle trajectory (b) Angle error and Lyapunov function 

Fig. 4: Control results by the proposed control law with n — 5 and 9* = — = Q% = 36 deg. 



VI. Conclusions 

We have studied the stabilization of angle-constrained circular formations using bearing-only measure- 
ments. We have proposed a discontinuous control law, which only requires the sign information of the 
angle errors. By using nosmooth stability analysis tools, we have proved that the error dynamics is locally 
finite-time stable with collision avoidance guaranteed. A number of important formation behaviors have 
also been identified. 
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As observed from the simulation results, the shape of the formation cannot be controlled because 
the underlying information flow is a circular graph, where each vehicle is associated with only one 
constrained angle. When there are more than one constrained angles at each vehicle, the formation shape 
may be well defined. Then it is possible to control the formation shape using bearing-only measurements. 
An immediate research plan is to extend the results in this paper to formations with more complicated 
underlying graphs. 
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